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方法 


摘 要 : 可靠 的 环境 分 析 是 实现 智能 车 自动 驾驶 的 核心 技术 ， 包 括 车 辆 识别 、 行 人 检测 、 碰 撞 避 免 等 ， 其 目标 是 实现 
驾驶 的 完全 自动 化 。 提 出 基于 改进 联合 概率 数据 关联 滤波 器 的 智能 车 立体 视觉 多 目标 跟踪 方法 。 利 用 立体 视觉 摄像 头 
采集 车 辆 及 行人 图 像 、 视 频 ; 在 Lie 群 下 对 传感器 的 不 确定 性 进行 建 模 ， 并 采用 欧 几 里 德 群 算法 对 预 处 理 的 图 像 进行 
状态 滤波 ; 在 可 能 存在 车 辆 的 区 域内 利用 双 目 视觉 去 除 误 检 ， 并 获得 车 辆 的 位 置信 息 ; 通过 卡尔 受 滤波 器 对 测量 的 不 
确定 度 和 预测 目标 运动 的 轨迹 进行 确认 ;运用 改进 的 联合 概率 数据 关联 滤波 器 对 车 辆 及 行人 的 跟踪 结果 进行 优化 修正 。 


实验 结果 表明 ， 提 出 的 方法 可 以 有 效 解 决 智 旬 


EE 车 多 目标 跟踪 问题 ， 


大 幅度 提升 


驾驶 系统 的 自动 化 和 智能 化 水 平 。 相 比 


其 他 较 新 的 目标 跟踪 方法 ， 提 出 的 方法 在 跟踪 精度 和 速度 上 具有 明显 的 优势 ， 且 在 跟踪 车 辆 时 不 会 产生 明显 的 偏 移 、 


不 会 遗漏 对 行人 的 跟踪 。 
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Stereo vision multi-object tracking for intelligent vehicle 


using joint probabilistic data association in Lie group 
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Abstract: Reliable scene analysis, which commonly involves vehicle identification, pedestrian detection, and collision 


avoidance, u, is an essential technique in realizing automatic driving of intelligent vehicle. This paper proposes a stereo vision 


multi-object tracking method based on joint probabilistic data association (JPDA) filter for intelligent vehicle: the method 


collects the images and videos of vehicles and pedestrians with the help of stereo camera mounted on top of a vehicle, model 


the uncertainty of sensor in Lie group, and adopt the Euclidean algorithm to implement state-filtering for the preprocessed 


images. Utilize the improved JPDA to rectified the tracking of vehicles and pedestrians. Experiment results show that the 


proposed method can settle the tracking of multi-objects effectively, and improve the level of automation and intelligence for 


driving system dramatically. Compared with other new target tracking methods, the proposed method has obvious advantages 


in tracking precision and speed. It does not produce obvious offset in tracking the vehicle and will not miss the tracking of 


pedestrians. 
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0 ”引言 实现 车 辆 驾驶 的 完全 自动 化 ， 并 在 提高 安全 性 的 同时 减少 导致 
道路 事故 的 人 为 错误 。 在 各 种 技术 中 ， 移 动物 体 跟踪 是 驾驶 畏 
在 各 种 不 确定 条 件 下 实现 周围 环境 的 可 靠 感 知 是 几乎 任何 ” 助 系统 的 关键 任务 ， 当 车 辆 可 以 检测 其 所 处 环境 中 的 动态 物体 

i 助 或 自治 系统 应 用 中 的 基本 任务 ， 尤 其 是 随 着 自动 驾驶 研究 。 并 预测 其 未 来 行为 时 ， 可 以 大 大 是 提升 车 辆 的 智能 化 水 平 。 
的 不 断 兴 起 ， 学 术 界 和 各 大 科技 公司 正在 积极 开发 先进 的 驾驶 由 于 需要 在 不 同 环境 条 件 下 的 实现 各 类 物体 的 实时 、 准 确 
甫 助 系 统 趾 。 各 驶 辅助 系统 的 核心 技术 包括 自 适应 巡航 、 避 免 。 跟踪 ， 目 前 还 没有 一 种 传 感 系统 可 以 完全 提供 目标 跟踪 所 需 的 
碰撞 、 变 道 辅助 、 交 通 标 志 识 别 和 停车 辅助 等 功能 ， 其 目标 是 。 全 部 信息 。 鉴 于 此 ， 驾 驶 辅助 系统 通常 借助 包括 毫米 波 雷 达 、 
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录用 稿 张 琦 ， 等 : Lie 群 下 利用 改进 JPDA 滤波 器 的 智能 车 立体 视 党 多 目标 跟踪 方法 


激光 测 距 仪 、 视 觉 系统 等 设备 的 复合 感 测 系 统 来 实现 移动 目标 “目标 检测 与 跟 实验 ， 实 验 结果 证 明 所 提 方 法 具有 非常 高 的 及 跟 

的 准确 检测 。 雷达 装置 外 能 够 精确 测量 物体 的 相对 速度 和 距离 。 ” 踪 精 度 ， 且 具有 较 好 的 动态 性 能 。 

激光 测 距 仪 中 具有 比 雷达 更 高 的 横向 分 状 素 ， 而 且 除 了 可 以 精 ee 

确 地 检测 物 距 外 ， 还 可 以 检测 物体 的 占用 面积 并 提供 详细 的 场 。 | ”移动 目标 立体 检测 

景 表 示 。 基 于 视觉 的 传 感 系统 可 以 提供 精确 的 横向 测量 和 让 富 通过 建立 立体 图 像 实现 对 运动 物体 的 有 效 检测 ， 但 是 观察 

的 图 像 信息 ， 从 而 为 基于 测 距 的 传感器 道路 场景 分 析 提 供 有 效 。 者 的 不 断 运动 使 得 检测 任务 具有 一 定 的 难度 。 为 了 实现 移动 物 

补充 。 其中， 立体 视觉 传感器 可 以 提供 具有 高 横向 分 辨 素 和 较 。“” 体 的 检测 ， 需 要 实现 传感器 模 态 与 物体 估计 的 融合 ， 首 先 ， 需 

小 确定 范围 的 目标 检测 ， 同 时 通常 为 物体 的 识别 和 分 类 提供 足 。 要 实现 基于 立体 声 的 运动 物体 检测 。 利 用 角 点 检测 器 来 检测 3 

够 的 信息 。 稠密 特征 点 ， 将 每 个 检测 到 的 特征 的 位 置 和 速度 在 三 维 欧 氏 空 
无 论 使 用 哪 种 传感器 ， 在 交通 场景 中 都 必须 解决 多 目标 跟 。“ 间 中 进行 估计 。 因 此 需要 确定 当前 帧 和 前 一 帧 的 左 侧 、 右 侧 图 


I 


踪 的 问题 。 此 时 需要 跟踪 每 个 目标 的 状态 ， 同 时 在 杂乱 环境 中 ” 像 中 的 特征 之 间 的 对 应 关系 。 为 此 ， 本 文采 用 光 流 程 方 法 和 立 
处 理 测量 值 ， 进 而 解决 跟踪 目标 数据 关联 的 问题 。 体 块 匹配 算法 计算 特征 对 应 关系 。 

文献 [外 利用 目标 在 形变 过 程 的 灰 度 特征 具有 同 频率 变化 首先 ， 在 对 图 像 进行 校正 后 ， 所 有 来 自前 一 帧 的 特征 点 通 
的 特点 ， 基 于 软 特 征 提 取 方 法 实现 了 目标 区 域 和 前 趋 信息 的 ; 过 标准 针 孔 照相 机 模型 投影 到 3D 世界 帧 中 ， 然 后 将 该 位 置 与 


确 检 测 ， 进 而 实现 了 形变 目标 的 长 时 间 稳 定 跟踪 ; 文献 [5] 在 各 ”获得 的 运动 矩阵 进行 复合 反 投影 到 当前 相机 帧 中 ， 并 连接 到 来 
视频 场景 内 事先 选 定 一 块 可 以 清晰 分 辨 目标 表 观 的 参考 区 域 ， 自 当前 帧 的 ， 对 应 前 一 帧 的 3D 点 形成 矢量 场 ， 其 中 每 个 矢量 
进而 形成 供 构造 模型 的 训练 样本 ,同时 利用 两 路 对 称 、 权 值 共 ”表示 相对 于 世界 帧 的 对 应 3D 点 的 运动 ; 其 次 , 由 于 在 3D 空间 
享 的 深度 卷 积 神经 网 络 实现 了 目标 的 准确 跟踪 ; 文献 [6] 基 于 变 。 中 测量 不 确定 度 具 有 高 度 异 向 性 ， 因 此 难以 精确 确定 沿 着 光 轴 
结构 运动 目标 前 景 与 背景 交界 处 具有 量子 频率 阶 路 不 变性 的 特 。 ”方向 的 运动 强度 ， 而 将 矢量 投影 到 不 确定 性 均匀 分 布 的 图 像 平 
点 ， 将 阶 跃 不 变 特征 描述 为 具有 独立 性 和 约束 性 的 视觉 量子 ， 面 上 ， 并 将 阔 值 赋值 给 每 个 点 的 运动 幅度 ， 然 后 根据 平移 和 旋 
提高 了 跟踪 精度 和 速度 ; 文献 [7] 在 定义 网 格 网 络 模型 的 基础 上 ， ” 转 参 数 将 剩余 的 矢量 连接 成 饺 ， 最 后 ， 如 果 至 少 有 3 个 向 量 出 
设计 了 基于 2 阶段 聚合 的 目标 定位 算法 ， 实 现 了 移动 目标 的 最 。 现在 其 中 ， 那 么 每 个 簇 就 对 应 一 个 移动 对 象 ， 并 用 所 有 相应 点 
短路 径 目 标定 位 ， 提 高 了 目标 定位 的 准确 性 ， 文献 [8] 针 对 无 监 ”的 质心 点 描述 该 对 象 。 

想 多 远 去 仿 油 | 三 RE 问 昌 于 粒子 滤 》 十 忆 六 

多 运动 目标 检测 与 跟踪 问题 ， 利 用 基于 粒子 滤波 和 背景 减 除 2 ”移动 目标 运动 模型 


的 方法 实现 了 多 移动 目标 自动 探测 和 跟踪 ;文献 [9] 基 于 DST 和 

PCR5 融合 运动 目标 的 颜色 和 纹理 特征 ， 并 在 粒子 滤波 框架 下 为 了 建立 移动 目标 的 运动 模型 ， 需 要 首先 简要 介绍 建 模 过 
建立 了 复杂 场景 下 的 多 目标 跟踪 模型 ， 实 现 了 多 特征 信息 融合 。” 程 中 用 到 的 Lie 群 、 欧 氏 群 等 相关 知识 。 

的 自 适应 视觉 跟踪 ; 文献 [10] 在 考虑 移动 目标 惯性 的 基础 上 , 提 定义 1 Lie 群 GL 是 一 个 具有 光滑 流 形 结构 的 可 微分 群 。 
出 一 种 基于 合群 性 的 分 布 式 跟踪 方法 ， 实 现 了 异 构 多 目标 系统 定义 2 Lie 代数 g 是 在 GL 的 切 空间 中 恒 为 单位 矩阵 的 
的 准确 跟踪 ， 文献 [1H 提 出 了 一 种 用 于 评估 多 目标 跟踪 算法 性 邻 域 ， 且 矩阵 指数 exp(GL) 和 和 矩阵 对 数 log(GL) 可 以 构成 一 


能 额 对 的 指标 ， 即 缺陷 感知 子 模式 分 配 ， 为 科学 评估 和 优化 跟 个 局 部 的 微分 同 且 ， 如 式 (D) 所 示 。 


踪 算 法 提供 了 重要 支撑 ; 文献 [12] 提 出 了 一 种 基于 自治 目标 的 1 一 G (1) 
新 建 区 域 提 取 方 法 ， 实 现 了 高 分 辨 率 远 距离 感知 图 像 的 高 效 分 log(GL):G 一 8 
割 , 进而 实现 了 移动 目标 的 精确 跟踪 ; 文献 [13] 基 于 随机 有 限 集 为 了 有 效 利 用 Lie 群 ， 需 要 引入 集中 高 斯 分 布 ， 此 时 涉及 
实现 了 缺少 精确 数据 情况 下 移动 目标 的 可 靠 跟踪 ; 文献 [14] 提 的 Lie 群 是 连通 的 单 模 李 和 群 。 
出 了 一 种 贝 叶 斯 跟踪 框架 ， 进 而 基于 置信 传播 方案 和 马尔 科 夫 定义 3 样本 对 的 概率 密度 函数 为 
链 实现 了 目标 的 快速 检测 与 跟踪 ， 文 献 [15] 将 自 适 应 遗传 多 模 P(X) =Aexp (Slog(X).P"'(og(X))] O) 
型 与 基数 概率 假设 密度 进行 有 机 结合 ， 实 现 了 多 目标 的 自 适 应 2 
跟踪 。 其 中 : 4 为 标准 化 常量 。 

通过 对 上 述 研究 成 果 进 行 仔细 研究 ， 本 文 提出 如 下 多 目标 此 时 可 以 利用 Lie 群 在 转换 将 式 变 为 GL: 
检测 与 跟踪 方法 : 首先 ， 利 用 视觉 立体 测 距 算法 估计 中 间 车 辆 X=6exp(log(X)) G) 
的 位 移 ， 将 不 符合 特征 的 物体 视 为 移动 目标 ， 将 其 测量 值 送 至 其中: 5 为 分 配 系数 。 
跟踪 算法 ; 其次， 基于 Lie 群 中 的 扩展 卡尔 曼 滤 波 器 构造 状态 定义 4 欧 氏 群 S 群 描述 了 二 维 空间 中 的 刚体 运动 ， 其 表 
不 确定 性 表示 和 运动 模型 ， 最 后 ， 通 过 改进 的 联合 概率 数据 关 ” 达 式 为 
联 (jointprobabilistic data association，JPDA) 实现 多 目标 的 准 -| a (4) 
确 跟踪 。 为 了 验证 所 提 方 法 的 有 效 性 ， 在 某 道 路 上 进行 了 移动 0 1 
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其 中 : 0,aERM!,; AER”?。 
2.1 状态 空间 
车 辆 是 典型 的 刚体 ， 因 此 需要 运用 刚体 运动 方程 组 描述 车 
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P(Xi ml 天 PE KF) P(A Fa) 4D) 
式 (11) 表 明 目 标 状 态 X; 的 密度 及 其 存在 性 yi 为 所 有 Yi 的 


辆 的 状态 。 此 外 ， 当 考虑 车 辆 的 速度 时 ， 也 可 以 通过 相同 的 运 
动 方程 组 来 表示 高 阶 的 状态 变化 。 基 于 刚体 等 速 运动 模型 的 等 
效 原则 ,将 状态 空间 GL 构造 为 两 个 矩阵 Lie 群 S 的 笛 卡 尔 积 : 
SxS=S: (5) 

分 量 ， 第 二 个 S 是 速度 分 量 。 

于 需要 将 模型 应 用 到 车 辆 跟踪 应 用 中 ， 与 其 他 运动 模型 
《恒定 速度 ， 人 恒定 角速度 和 速度 ， 恒 定 曲率 和 速度 ) 相 比 ， 式 
(5) 的 运动 模型 提供 了 较 好 的 灵活 性 。 这 种 灵活 性 通过 在 纵向 、 
横向 和 旋转 三 个 分 量 上 的 速度 表现 出 来 ， 提 供 了 能 够 描述 出 现 
在 不 同 场景 中 的 车 辆 、 摩 托 车 和 行人 等 对 象 的 能 
Lie 群 中 的 矩阵 组 合 与 反 演 就 是 简单 的 矩阵 乘法 和 反 演 ， 


其 中 : 第 一 个 S 是 位 


因此 对 于 所 有 GL 上 的 运算 ， 可 以 使 用 对 角 化 放置 GL 块 的 两 
个 S 而 构造 的 符号 进行 表示 。 
2.2 ”运动 模型 
车 辆 的 运动 模型 为 
Xi =Xi:exp(ao +C) (0) 


其 中 : 和 rEGL 是 系统 在 上 时 刻 的 运动 状态 ; ax 是 一 个 非 线 性 函 
数 ，pBi 是 高 斯 白 噪声 。 

如 果 第 大 1 步 的 后 验 分 布 满 足 Lie 群 上 的 高 斯 分 布 ， 那 么 
可 以 根据 下 式 对 式 (6) 所 示 的 运动 状态 进行 预测 : 


Xi = Xi exp(log(%)) (7) 
此 时 可 以 将 式 (6) 所 示 的 运动 方程 重新 建 模 为 
wm=pm vw @ 00 0 
T (8) 
-| 不 Pa Por 
Bh-| 估 学 驮 BB Bh 


其 中 : wk we ok 分 别 为 纵向 、 横 向 和 旋转 速度 ; Bix、pzx、Pox 
分 别 为 高 斯 噪声 在 纵向 、 横 向 和 旋转 三 个 方向 上 的 分 量 。 


3 ”移动 目标 跟踪 


在 本 文中 , 假设 跟踪 的 多 个 目标 为 {Ti,…,Ti}， 所 跟踪 目标 
的 数量 随时 间 而 变化 ， 也 就 是 说 目标 可 能 从 传感器 的 视野 中 
随时 出 现 或 者 消失 。 

定义 丈 表 示 磊 时刻 所 有 检测 的 集合 ， 即 


Y={Y: i=L...,n} (9) 
定义 x: 表示 所 有 度量 的 历史 ， 即 
Yix = {8h} (10) 


除了 目标 初始 测量 之 外 , 矢量 丈 还 包含 满足 泊 松 分 布 的 随 
机 变量 (和 杂 波 )。 需 要 解决 的 问题 是 如 何 将 接收 到 的 测量 集合 适 
当地 分 配给 运动 轨道 中 的 目标 ， 以 及 如 何 管理 待 检测 目标 的 出 


测量 ， 
对 于 


日 与 上 相关 。 
标 存在 的 概率 ， 采 用 马尔 可 夫 链 模型 进行 描述 : 


P(xil Yi1)=p:P(x V1) (12) 


其 中 : p 表示 
根 
扫描 到 


标 在 大 1 时 刻 存 在 时 ， 其 在 上 时 刻 仍然 存在 的 概 


居所 获得 的 测量 值 丈 可 以 通过 总 概率 公式 
标 Ti 的 后 验 密度 为 


E 测 出 时 刻 


P(Xi, 2 Fa) = P(X Yo) Bo P(X 0,2 Hs) (13) 


其 中 : oi 表示 物体 存在 的 后 验 数 据 关 联 概率 ，yi 表示 概率 假 


设 。 


被 测 


标 存在 的 概率 为 


P(xil Ya)= BP(m, xl Yi) (14) 


为 了 计算 os 、yw， 需 要 在 对 象 集合 中 考虑 测量 到 对 象 的 
关联 事件 。 此 时 假设 i 由 所 有 可 行 的 关节 事件 严 组 成 , 其 中 每 
个 轨迹 具有 零 个 或 一 个 测量 ， 并 且 每 个 测量 被 分 配 到 零 个 或 一 
个 轨迹 。 此 时 有 


P(x x)= 2, PE 3) (15) 
Pn Yay)=1- YP Xl Ys) 

Ti; 存在 但 没有 被 集群 内 的 测量 检测 到 的 概率 为 
Po 区 1a)= CH Ye) (OL Ia) On 


1-P(F| ¥,) 
为 了 计算 每 一 个 关节 事件 F 对 应 的 P(F| 区) ， 需 要 分 配 


测量 的 目标 集合 C， 以 及 分 配 一 组 测量 的 轨道 集合 D， 此 时 可 
得 


= P(x AA CD)) 
P(F| Yi) IIU P(x Fx 1)) II p(T(Fi)) 


丰 P(xl 人 的) 生 P(x 人 


(18) 


其 中 ，pp, 是 被 检测 到 的 概率 ，p 是 修正 后 度量 在 7 的 门限 


闹 信 范围 内 的 概率 ; z(,i) 是 在 关节 事件 下 分 配给 工 的 度量 
的 索引 ， pi, (r(F,i)) 表 示 杂 波 先 验 度量 密度 。 
根据 式 (18) 可 以 计算 旋转 概率 : 


; 1-P (xil Fa) 
i (TP,i))=— ee -EL 
pi(T( i)) P, (xil ZN) 


为 了 满足 门限 阔 值 ， 公 式 (19) 所 示 的 旋转 概率 通过 Pa、Ps 


“p(T(F,i)) (19) 


现 和 消失 。JPDA 方法 通过 估计 每 个 Ti; 的 后 验 密 度 来 解决 这 一 


问题 ， 即 


进行 了 标准 化 。 
上 述 公 示 可 以 得 到 所 有 要 素来 确定 目标 存在 的 概率 : 
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| Re 步 方式 执行 的 状态 估计 ， 因 此 需要 确保 这 两 个 传感器 的 时 钟 同 
P(x Fi )= EP(m,xil ¥,) (20) 
局 步 。 虽 然 两 个 传感器 都 工作 在 接近 的 频率 ， 但 在 情况 中 可 能 会 
进一步 可 以 计算 出 联合 数据 概率 : 发 生变 换 。 因 此 ， 预 测 步骤 直接 取决 于 时 间 周 期 T， 即 ， 在 两 
有 (21) 个 连续 时 刻 直 和 对 1 之 间 的 时 间 。 因 此 ， 数 据 采集 的 时 钟 漂移 
”P(xil Yi) 或 较 大 的 延迟 可 能 会 显著 影响 算法 的 性 能 。 


4.2 比较 及 分 析 

为 了 充分 验证 算法 的 适应 性 ， 进 行 的 实验 测试 包含 多 个 高 

4.1 实验 平台 与 条 件 度 动态 的 场景 ， 并 且 同 时 对 车 辆 、 电 车 和 行人 进行 跟踪 。 在 实 

为 了 验证 所 提 方 法 的 有 效 性 ， 本 文 在 实际 场景 中 搭建 了 基 。” 验 中 , 一 旦 物体 的 存在 概率 超过 了 P(zi| 7,) = 0.93， 轨 迹 就 被 

于 市 区 环境 的 传感器 实验 平台 ， 并 进行 了 相关 实验 。 为 了 表明 ”确认 为 真正 存在 的 物体 , 如 果 存 在 的 概率 低 于 P(xi| ¥,)=0.15， 

本 文 所 提 方法 在 目标 跟踪 方面 的 优势 ， 将 所 提 方 法 与 文献 [13] 。” 轨迹 将 会 被 删除 。 

提出 的 方法 进行 了 实验 对 比 。 实 验 平台 包括 主要 由 两 套 立 体 摄 实验 持续 时 间 为 90 s， 不 仅 涉及 移动 车 辆 前 行 、 右 转 ， 而 

像 机 系统 安 组 成 。 立 体 图 像 使 用 单 色 的 相机 系统 录制 ， 相 机 系 且 包 括 静 止 车 辆 、 移 动 行人 、 静 止 行人 。 实 验 结果 如 图 1-4 所 

统 具有 150 万 像素 的 全 局 快门 传感器 , 图 像 分 辨 率 为 1280x960 示 。 图 1、3 分 别 为 本 文 方法 与 文献 [13] 方 法 在 左 侧 相机 的 跟踪 

像素 ， 水 平视 野 50"。 由 于 预期 的 目标 测量 范围 为 40 米 ， 所 以 ” 结果 ， 图 2、4 分 别 为 本 文 方法 与 文献 [13] 方 法 在 右 侧 相机 的 跟 

在 20 Hz 的 最 大 帧 速率 下 使 用 最 大 的 20 cm 长 基线 进行 实验 。 踪 结 果 。 表 1、2 为 两 种 方法 在 跟踪 精度 和 速度 上 的 数据 对 比 。 

立体 图 像 的 同步 在 系统 内 部 执行 ， 实 验 在 相机 的 自动 曝光 模式 ”实验 中 ， 在 对 原始 传感器 数据 进行 预 处 理 后 ， 平 均 每 帧 有 2.12 
下 进行 记录 。 个 立体 相机 检测 ， 产 生 305 个 轨迹 。 

于 实验 平台 包括 两 台 相 机 ， 且 所 提出 的 方法 依赖 于 以 异 


4 ”实验 分 析 


< 


(a) 远 距离 (b) 中 距离 (c) 近 距离 
图 1 本 文 方法 左 侧 相机 跟踪 结果 


(a) 远 距离 (b) 中 距离 (c) 近 距离 
图 2 ”本 文 方法 右 侧 相机 跟踪 结果 


(a) 远 距离 (b) 中 距离 (0) 近 距离 


图 3 文献 [13] 方 法 左 侧 相机 跟踪 结果 
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(a) 远 距离 (b) 中 距离 (0) 近 距离 
图 4 文献 [13] 方 法 右 侧 相机 跟踪 结果 
表 1 两 种 方法 的 目标 跟踪 精度 车 辆 的 运动 规划 等 功能 是 非常 有 帮助 的 。 此 外 ， 立 体 相 机 的 检 
远 距 离 中 距离 近 距 离 测 过 程 不 依赖 于 物体 的 特定 外 观 ， 并 且 可 以 检测 任意 运动 ， 包 
左 侧 相机 本 文 方法 99.1% 99.3% 99.7% 括 如 图 1~4 所 示 的 汽车 和 行人 的 运动 。 
左 侧 相 机 文献 [13] 方 法 90.5% 91.7% 93.8% 
右 侧 相机 本 文 方法 98.9% 99.2% 99.6% 
右 侧 相机 文献 [13] 方 法 90.1% 92.1% 94.2% 


表 2 两 种 方法 的 目标 跟踪 速度 
远 距 离 中 距离 近 距 离 


左 侧 相 机 本 文 方法 7.3ms 6.9ms 6.2ms 
左 侧 相 机 文献 [13] 方 法 11.6ms 10.3ms 9.8ms 
右 侧 相 机 本 文 方法 7.1ms 6.7mas 6.4ms 
右 侧 相机 文献 [13] 方 法 11.1ms 10.4ms 9.2ms 


通过 对 比分 析 实 验 结果 可 知 , 相 比 文献 [13] 提 出 的 方法 , 本 
文 方法 在 跟踪 精度 和 速度 上 具有 明显 的 优势 ， 而 且 不 会 遗漏 对 
行人 的 跟踪 ， 且 在 跟踪 车 辆 时 不 会 产生 明显 的 偏 移 。 此 外 ， 左 
右 两 个 相机 的 实验 结果 是 相同 的 ， 可 以 实现 同一 场景 下 不 同 目 
标的 准确 检测 ， 当 目标 不 断 移动 时 ， 本 文 方法 也 可 以 实现 二 者 
的 准确 跟踪 。 
4.3 不 确定 性 测试 
图 5 和 6 显示 了 两 种 不 同类 型 的 传感器 进行 LG-EKF 滤波 
器 状态 不 确定 度 更 新 的 结果 。 在 实验 中 ， 滤 波 器 预测 都 遵循 S 
运动 模型 ， 并 产生 香蕉 形 的 状态 不 确定 性 。 图 5 展示 了 基于 椭 
圆 测量 不 确定 度 传感器 更 新 滤波 器 的 结果 ， 类 似 于 “经 典 "的 高 
斯 不 确定 性 。 图 6 显示 了 基于 立体 视觉 传感器 的 范围 比 导 向 具 
有 更 大 的 不 确定 性 的 结果 ， 注 意 预 测 的 不 确定 性 偏向 右 侧 ， 表 
明 车 辆 向 右 转 弯 的 可 能 性 高 于 左 侧 。 从 上 面 的 例子 可 以 看 到 渡 
波 器 如 何 处 理 不 同 的 测量 不 确定 性 ， 并 有 效 地 将 它们 与 预测 步 


又 中 的 信息 融合 在 一 起 。 

实验 结果 表明 ， 提 出 的 方法 让 辅助 驾驶 系统 在 立体 视觉 协 图 6 “立体 视觉 的 测量 不 确定 性 
助 下 ， 实 现 复杂 环境 中 运动 物体 的 精确 跟踪 。 然而， 使 用 这 些 基本 卡尔 曼 滤波 器 形式 的 JPDA 滤波 器 代表 了 一 种 用 于 多 
传感器 的 可 用 数据 集 都 不 包含 地 面 实况 数据 ， 因 此 很 难 确保 对 。 “目标 跟踪 问题 的 完善 方法 。 通 过 执行 所 提出 的 实验 ， 验 证 了 加 


所 提出 的 方法 进行 量化 的 实际 评估 。 不 过 ， 由 于 $ 状态 空间 具 入 两 个 基本 多 目标 跟踪 构建 模块 的 方法 : 状态 估计 和 概率 数据 
备 优异 的 跟踪 性 能 , 因此 如 果 系 统 的 特征 空间 是 欧 几 里 得 空间 ， 关联 方案 ， 两 者 均 是 基于 Lie 群 的 几何 结构 。 
可 视 实现 状态 空间 几何 形状 的 充分 解释 。 
5 结束 语 
从 估计 的 角度 来 看 ， 提 出 的 方法 的 优点 在 于 对 传感器 和 跟 
踪 对 象 的 不 确定 性 和 运动 进 灵 活 行 建 模 。 这 对 于 预测 对 象 的 未 针对 辅助 驾驶 系统 在 背景 下 的 跟踪 问题 ， 提 出 基于 立体 相 
来 运动 和 其 不 确定 性 是 有 利 的 ， 同 时 对 于 实现 避免 碰撞 、 自 主 机 立体 视觉 测 距 的 车 辆 的 相对 位 移 估 计 方 法 ， 生 成 不 符合 估计 


运动 的 光 流 矢量 的 聚 类 中 心 的 测量 结果 。 由 于 两 个 相机 存在 频 
率 同步 问题 ， 因 此 利用 Lie 群 上 的 异步 卡尔 曼 滤 波 器 对 二 者 的 
检测 信息 进行 融合 。 提 出 的 运动 目标 表示 方式 可 以 实现 传感器 

测量 和 车 辆 状态 不 确定 性 的 准确 描述 。 为 了 解决 多 目标 跟踪 问 


题 ， 对 JPDA 滤波 器 进行 了 改进 ， 使 其 与 Lie 群 上 的 卡尔 曼 滤 
波 器 协同 工作 。 利 用 在 城市 交通 场景 中 记录 的 真实 数据 对 所 提 
方法 进行 了 测试 ， 实 验 结果 证 明 所 提 方 法 可 以 精确 、 快 速 地 实 
现 移 动 目标 的 检测 ， 从 而 提升 辅助 驾驶 系统 的 智能 化 水 平 。 在 
本 文中 ， 已 经 在 先进 的 驾驶 员 辅 助 系统 的 背景 下 解决 了 检测 和 


跟踪 问题 ， 但 是 没有 考虑 车 四 
一 步 可 对 其 进行 研究 ， 实 现 对 
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